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[If ^JI 1 ] 

bo ib 3 Kit ft & \z m -o x &m -t * x s <^ mi* % l * 

s ti feaitfl ic ^ ~> x ^ e nf n « c xs <o s * s & -t * wam\ m urn . 

Sift t a. iff H§<7> MSc L T^ffc-t * figiit 1^7 <> 

[M^JI 2 ] 

3 iX7C * n vM F ftit^T^^T'^it * If *Jl 1 tc IB frJPTrSo 
[» 1 1 



P = P 0 + £ = P^ + h £ u<tf , 0 < j < /*, 0 < £ = |- < 1 





cos jS 


— sin /J 


0 


cos a 


0 


sin« 








cos/J cos a 




sin /3 


cos j3 


0 
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< 






sin /? cosor ► 




0 


0 
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- sin a 


0 


COSOJ 








- since 



a = a 0 +tf,S + o 2 5' 2 (3) 
JS =b 0 +b l S+b 2 S 2 (4) 







V 


< .V 


s P, = < 




z 







% h XgiJ o fcffi* STibt, S liMiX7C<50ffiT*> ♦) . 3 tit: ftl^^^S t of ^ 
i , j . k t± tl tl . x ttu y$l.^c/z$iij^ft<^i£te^?F^T-£>*o 
uli^CPfc4Jtt*fl*ft<?)JtJj6^|nI*^-t#-'a^^ H ^ T *> •) x ^ ( 2 ) tc «k o T 4- £ «b tl 

* o E^&VEiaiiHfevF '] ^sT-J)^ * ft k $1 * *> 9 <r> % m. P co @KS V 
j 1***3 O ^ftma LTi^. hu%^ 3 - (yaw) M % t° -v ( p i t c h) 

* <r> % \z k 16 £ t> *) \z $ fl Vf 0 ~t Z t \z J: o T . t# *g ~* * h ^ u i'H^tlS C i: LT 
u * o 

a o » a j . a b j. b \ . b 2 ft ° 
[If^H3] 

ft* 3 iX7Ett*l ( 3 /^7U ?n«MH ftf$ t 7 ) ^ffluTHM * li -7 - * <7>t&f^ 

hu ib 3 7c ft m iz m o t ^tfr-r ^n^iitjg^L, 
^s$n^st^c^oT^fi^^^icxm<^#iHi^^sti]-t*i(fi^ijp^go 

[If^H4 ] 

Xa<^jgift*»«fW«p-t* fc*>k: . 

=1 > tf — 9 ~£ , 

tl* 3 iX7Cft*ft ( 3 /^7U ?B'MH ffiftg t 7 ) ^fflV^TXB#l» * fc»± 7 - 9 ^f^f^ff^ 

KIB3 ^TCftllC^oTfit^II^Iitlg/ttS^Si: . 



[it ^ji 5 ] 

n y tf =. — 9 , 

fiz 3 Aitmm (3^7c^ny n-ftitin) -km^xxmMi^ - ? ^t&i^ 
zzt*. mm tit. m m^mwt tx^it-t ^itmrn 1 . 



[mm%] mmm 

[ 0 0 0 1 ] 

*^BHti. d#'; XfF^M. Siii, if^f^^^M ( n # -y Fftu 

[ 0 0 0 2 ] 

il^^^JUr-n LTA^^tiS. Lti'oT^ & HI 0% £ lc ti . &A 

^> 7j >£ * ffl V> T j&flj % ffl ffl -f & £ . 

[ 0 0 0 3 ] 

^ > ffl ra . 3 ix^ x 7- v 4 > ?gn * ^ *»*n tix s h ti tz&^mm \z m *> 

[ 0 0 0 4 ] 

Li)X, 3 iftj** 7° ^ 4 >fflMtt. »M^»«i**if fc*v>3ftil^f!C*«E^irSC t LT 
4^tltoTu5. Zc?y 3 iX^^T^ 4 >*tWii, #iJ&^<b<?>^im«l i: ft*<7>W 
[fSBflcT)^] 

[f£Bflfc*ftm L =fc 7 fctiSS] 
[ 0 0 0 5 ] 

2 /yXTCtefcv^T ii^f x. ^> fflWy^vS i: LT. ? n vM t* *t W i£ fc* flj # <b 

T * n V 4 H 3 iyvTUlcM L . g i /&*U <7) ffl W lc ffl o ft \t . ft*ft^^ $ ^ ffl » t L 

9 -6 =k 7 & ftJflP % # ^ ic HIT § £ i: ® ti & . * . ftil^^'y LTu 

3 JXTclcM-f § z t li$({ift!J$n& ir<7)^ffk:4yv>T*MT*»S 3 i: *»JW^r$*i*. 3 ti 
*Tk:^ny>fl<ftJj**3iX7Ck:fl£^Lfc s t<?)i:L-Cl±x L i b<7) " 3D Discrete Clotho 
id Splines" (#!ff fF^CSK 3 #M) * ir **^n «b ti T 5 ^\ ^^^f y n y ttlt 3 
/yv7nlc^^i Lfct^tt^«btiTv^v^ ^^fl^T^SS^li. § fit * S lie tti T § 5 j&T 

[ 0 0 0 6 ] 
[ 0 0 0 7 ] 

[#ifffF£iSK 1 ] W>iSflT • feffllSycf i " fE^-ftC A D/C AMy x -r- a " Aft 

. 1997 

[#ff fF^i« 2 ] tfLBfffi, JRff#, Mffl^#. IHOjff^, " ^ n V -i H lc § gtftiffl 
W v£ " ( H * a # -y h 8 ^ 6 , p p 4 0 - 4 7 ) 

[^N#fF7^S^3] Li Guiqing, Li Xianmin. Li Hu a "3D Discrete Clothoid Spline 
s " , (CGI ' 01, pp32 1-324) 

[mm* mm-? z tz^^^m 

[ 0 0 0 8 ] 



[ 0 0 0 9 ] 

K^l^jtT-Jfx h HZ 3 YKTtmm ( 3 JXtu ? a v A Hffiinin) ^ffluTXMfiEfri; 
li "7 — ^ <jo im$$JfZV\ *MML . hu IB 3 iX 7C ft *ft tc vft o T ^Ift i- S I S ® Ift ^ L . 

[0010] 

[K2] 



if >i<ji i icie«<^^ft$ijp^v£icfcv^T . 3 Kit ? o v a v mm* 



P = P 0 + I' uds = P 0 + h £ uJS , 0 < 5 < h, 



cos jS - sin /5 
sin /? cos /3 
0 0 



cosa 
0 

— sina 



0 
I 

0 



sin a 
0 

cosa 



0 < S = -< 1 
h 

cos p cosa 
sin y3 cosa }. (2) 
- sin a 



(1) 



(3) 
(4) 





X 






p = < 


y 




-V(i " 




z ^ 







(5) 



It * ti -P ti . 3Ktc^o h*lii^*^fiI^n'K & V ^ </> f] 8H M £ ^ "t o 

^hT-IJofcl^ST'ibt. S liMiX7C<7>ffiT#> 9. 3 fl * ft ttUHE & t nf ^ „ 
i , j , k * ft f ft . xi, y tt x 7k U z tt ^ |Sj <?> Ijl -< ? ^ , u & § o 

o E k ^vEi«ti0Kvh * ft % ft . VLttoHfr *) <?>ftm p <n®mjku } 

tt*b^ftSa^0fetil)LTi^. 3 - (yaw) 0$k. It* * tf -v * (p l t c h) 0 

5* ( 2 ) t± * iW^lSjiO^^^fh^^. £ -f j tt £ t> *) \z a 1z t+ 0 L . L fc> S 
<t> *, tc k tt * t> *) ic (9 fi it 0 i- z t tc «k o X , mm ~* ? h^u^ibti^c^^LTu 

-So a o • a 1 • a 2' 13 0 ' ^ 1 ' b 2 
[0011] 

m&m 3 <7)^B^a. m^^fsj^ ^ v *ftjku3 -ftco^ti^iifrmmg: * ferna**^ 

:t\ lata, nfm*>W8c t LT^ffc-rsteB'fitffifcv* 7 o 

[0012] 

m^M4 commt. Tm<?>mM*®u$.Mffl~tz>rzdb\z. mmnfa^^ 
v *ftjkvB -n^^ti?nfrmm^*tz\$mm^^WL<n~fc^x*5-z.hiiz> 3 ftitmm 

[0013] 

if^n 5 ^mmit, xm<7>MWf& j &<$.fflW't&rzi£>\z. u ^ ^ ^ - 9 * , mm^fa^^ 



fcae&Lfc:3>fc:~-7^*BK9^flfcftgeii«#-?*>-5. :;t\ li^u, ufP^^nm 

[^Bfl^^] 
[00 14] 

* fcttft*ft^^SClc ffl LTjIIwT-£>£ d i: SE 3 ft 5 . fv^Jlititt, — o<7>?nv>f 
t# «b ft . ^ ^ [c Mil tfo ft u il S ^ ffcfc H 51 i" § it teffeO 9P ^ **nr || t ft * . 
[0015] 

Sfflfflvi. 3 Kit? a v ^ Hfflm%fflv^»:fftftiJ8P^ii»c^ttT)KiXlft^-t*. 
[0016] 

1. 3 iX7G* n vM h* ft** !ff& 
(1) 3iX7C^o V ^ K<?)S*jt 

*nvMKft*MClothoid curve) . SO £ 3 ^ - ~ - <r> ffig^Se (C o r nu ' s s p i r a 1 ) t ^ of 

lift. ftjft^Jis tctb^J LTtt$ii)*tfl:t^fliT'i>5, 

13 2 ic ^ 2 ft S x y ffi ^ _h iz is v> T . H 3 ti £ . 

[#3] 

P = P 0 + jV*fifr = P 0 +/ijV*rf.S, 0<j</j, 0<S=^<1 (1) 
4>=c 0 +c,.y + c 2 .y 2 =<j> 0 +(j fv S+<j) t! S 2 (2) 

P = a- + jy, y = V^T 

P 0 = * 0 + /Vo 

= cos0 + jsin(p 



(3) 
(4) 
(5) 



( x iik^lS]) <b JxBfff * 9 icllj <b ft S o C comfit * h >HctR/hil £ d s * *Mt 
T If ^ f § t E±tl *S _h <D & P ^ db h ft Z> . 

^) thus, s % h tsu o fcflt* ST-ifct. s aM/X7c<50MT*> *> . ztismmM 

? u y -i K fttlt^>4f &l±, it ( 2 ) T-^ L £ «fc 7 tc . Jf*ft?j ftft * s * H ft<* 

*^fCS<J0 — iX3*-?ll*>3ft.&Zi:k:*>S. c o , c j . c 2 * It <t> q . * v • <f> n lt ~'iXxK 

Z fLhJkumm<r>£^kh & ? n V A V <r> => > - ? i: Pf ^. HI 2 l± — Ax 
ft j7 n V >f H ft*ft«o0^*^-t. 

1M±.<7> 3 ^TUtcffi^ L X . 3 iX7C^ a V >f H ft*ft<?)^*f^*. t*3iX7C^n V 



3 Kit ?p'mh ^m^^ir^x^x-mm-t & . 

[S 4 ] 



P = P 0 + |u^ = P 0 +/z Ju^, 0<jr</j, i). • < -- "- ; i 

cos /J ~ sin /} 0 
sin jS cos p 0 
0 0 
a = a 0 +a^S + a 2 S 2 
j3 = b^ + b i S+b 2 S 1 



n-E k 'E*{\) = 



1 



/7. 

cosa 0 sin a 

0 1 0 
-sin a 0 cosa 



(6) 





Y 




cos /J cosa 








sin f) cosa > 








— since 



(7) 



(8) 
(9) 





X 






p = < 


y 








z 







(10) 



ti-eti-etu 3 ^tu f n v 4 h _h<7)*<^^g-< ? h >i , jku^e cowmii.'&^'t, i. j, 
k ti <?■ ft € ft . x Wr. y $A . s^zi^i^^lt^n^-ets. 

4 . j$ ( 7 ) tc 4? v> T . E k f 9 & V E ) a ti 0 $e v h >; ^T^ 1 ), 13 3 tc ^ £ ft £ J: 7 tc . 
* ft <? ft . k tt ( z $1 ) * t> *) <?> ft Jg 0 <?> @iS V j $1 ( y Hi ) t^^<^ft]^«^[El$E^ 
^bLTi^, bu#£ 3 - (yaw) tf -y (p i tch) ft^ t . ( 7 ) ti . ii 

(xltt)^fS]^^fi^^h^^s j i (yi) Ht> *) tc a tzl-tML . L ^ t c k 

Hi ( z Hi ) £ *) tc (9 fi it 0 i- z tc «k o t . li^n ^u^ibtisc t^^Ltu 

o 



3- ti . ft <?> }f m ^ ? h ^ u ti . f -y * ft a Jk V 3 
-^^blKtH't^ f y * ft a fc* 0 £ t . x yf HT'tv>fc2iX7U^ny ^ H 
ffi*ftfc*#<btl* 3 -ft /? ft* 0 i: . y z ¥fflT#v^ fz 2 Kit t n V 4 H «b tl § . 

tf f$ 7? 0 7? ft -< ? N >v u tci^/Jx4%$ d s *iM*Tf*#-*<5 3 /yvTC ?nvn* 
tl § „ 

3 iX7C * n vM H ft ijft tc T ti . Jg Jjft ~* ? H >v <F> \£ v + ft a Jklf ~3 — ft $ ti * tl f tl 
^ (8 (9 ) tc^-t «fc 7 tc tt^4%^i(S^2/yX5t^ J f x ^ti^o :^):i:l:ioT 

m*67i ft^^fb^ S i tcii^=5r^^ . =5rfe^o. ^<?>^fbtC3iM'l4^Jf fc** 3 t fr^m 

Wi^^tioT^Lfcrt < . 3 iX 7C * n vM H ft H ti r ti *H ^ ft <^ ^ ^ * ft Jk U 3 
-fttK % ti^tift^^^fC<^ — YKx^T°mt> £ ft 5 fl Jj6T*> -6 J tSU^ftSo 
P 0 *6 * s — o 3 7U ^ ^ v -i y -b r > > h ti . 
[»5] 



a 0 , a A , a z , b 0 , b } ,b 2 , h 



(11) 



co 7 M<7>'-<^ i-?tJ;oT-a;£^ti§. ao^v^Lb 2 ^6o<7)^^tift^<?>^.fi^:tf*> 
, ?n'M^ri>Fwf^tibUv^. d ft tc ?t L h ti 4% ^ </) ii ^ ff . 

[00 1 7 ] 

( 2 ) ©J^1i 

^ ( 7 ) tc fcv^T . ft 1^77 ft ^ ? h 'i i <y>n *) lz m^mm%< [ i , j , kltftAtS 
i: x /X^tft^fll (moving irame) E * f# £ . 



[R 6 ] 



£»[u y w]= E Ja [i j k] - E kfi E Ja [I] = E^E* 

cosjScosa -sin/3 cos /J sin a 

sin/3cosa cosjS sin j8 sin a 
-sina 0 cos ex 





cos j8 coscc 




r • oi 
— sm p 




cos jS sin a' 


u = < 


sin jS cos a: 




cosjS 


w - < 


sin jS sin a > 




- sin a 




0 




coscc 



(12) 



(13) 



:;T\ v^^wiifti^i ^ ic 

^7F) 14 ift j& P i: t t ic Ift < 7 U 
WlUWifr h^X»^sb h ft£ fzdb. 
ft* # Hi 1C T*§ l>. 

E <7>#J l$.Jk vm-i& & * ti ? ft E o , 

m ? ] 



fi it & ffl 1C a" 15 ft & & it -< ? V >IX° £> 
>l- u t 0. 3$ ~t Z> o C<7>3o<7)|ifi-<? 
-A (ffij|St&. j^fll) £ft£ 
± >£ H . glj v£ ft <7) ff g ^ IC & *) . 



9 . 2 

h ^ CO 

Sft&tS 



v> ic fi. 5£ 
ffl ( h ^ 



£ 0 = 
E s = 

t £ 
[ 

( 

m 

n — 
n 



■5 o 

0 0 18] 

3 ) n — > r 

£ - i: lc J: o T . 
^ 14 Jt & 7j ft * t> *) <r> 0 K T* £> 
% 4- x. 4 o fc* , 3 JX 7U ? n V -f 



(14) 
(15) 



3oB<?)0i r a - >i (roll) J ~& %k 7 



k icg?t*? s ft s iambic 14 



1^ 



•J T g t±3 \Z 0 $5 -t S 3 fc*T« § § 

mm it Tst 



ft** *) 

* <r> z 



i: tc J: o 



E = E kp E Ja E iy I = E kp E Ja E ir 

u — ji % Y icouT 
[» 9 ] 

y = c 0 +c { S + c 2 S 2 



(16) 
(17) 



[0019] 

(4)3 /Xtu ?n-MF ffi^co^fBT^^ttH 
( a ) 3 YKIt ?nvn* ft*ft<J0>S*l 

3 iX7cft*ft<7>i£*ft~* ^ h ^ 14. Jf*l^0^ ^ h ^ u ^fflv^T )X^^T-^ $ iiZ z t h*%a 



m i o i 



n = 



Kl 



(18) 



-a '(S) cos p (S) since (S ) -/T (S) sin p (5) cosce (S)" 
u '(S) = - ~a ' (S) sin J3 (5) sin a(5) - j8 ' (5) cos J3 (5) cosa (5) 

-ce'CS^cosaCS) 

j|a'(5)| = V« ' (J) 1 + j3 '(S) 2 cos 2 a (5) 



(19) 



[Kin 



n(S) = 



u'(S) 



Va'(S) 2 +j8 , (.S , ) 2 cos*a(,S) 



-a ' (5) cos jS (5) sin a (5) - /3 '(5) sin p (S) cosa (5) 
a'(S) sin j8 (5) sin a (5) + 0 '(5") cos p (S) cosa(S) 
-a'(S)cosa(S) 



(20) 



[ 0 0 2 0 ] 

( 7 ) <?> }t n u <?> t m n ic mm n ic o ^ t t % ^ x ^ -5 . mmmm^fa c 

,0,0) ICWLT, ^Wai^^I^Sty ^fflv^T ( 0 , cos y , -sin y ) 
C tl^ff,^ i: \5] £ J: 7 ic @i £ -t± £ t . mm n T 10 <^> =); 7 ic ^ £ tl S . 
[S12] 



n(S): 



cos a (S) 0 sin a (S) 

0 1 0 
-sin a(S) 0 cosce(S) 



cos p(S) -sin/3(5) 0 
sin/J(5) cos/?(S) 0 
0 01 
- sin v cos p (S) sin a (5) — cos v sin /? (S) 
-sin vsin j3(5)sino;(5 , ) + cosvCOSjS(S) 
-sin vcosa(.S') 



0 

cos V ► 
— sin v 



(20) (21) vy^Vcm-f £ t 
[K13] 



sin v = 



cos v = 



«'(5) 



^a\S) 2 + p\S) 2 cos 2 <x(S) 

/T(S)cosa(S) 
ja'(S) 2 +p\S) 2 cos 2 o(5) 



(22) 



(21) 



s i n y , cos y ti T Ifi ie l£ L T -g, 3 t fc* t> Z> 



[ 0 0 2 1 ] 

( c ) 3 )%7t 9 n v -i K M IC felt £ m^^T^vS^il^ 

3 z^tc ? a v >f k mm\z£>ii- ^mm^x-comm^m^m^-t % \z (22) «* 9 



[114] 



tan v = — — — — (23) 

p\S)cosa(S) 



. MfficT* tl It =k C t a* t> Z> o 
[ 0 0 2 2 ] 

( d ) 3iX7C*nvMh*ft*fc*>ffi4s 
[115] 



K (5) = - = s i = i i-i !!■ (24) 



(19)5£«fct>, *^J±, 



Ja' 2 +B ,2 cos 2 a 

K (S)=! tL (25) 

h 

[ 0 0 2 3 3 

(5)3 YKJt ?nv^H ft 
( a ) ftJft*>]gij§gtt 

— o <?) ? n V -f Ftri> h ( TO — co m- ^ > - 9 X' ft t> 2 tl £ ? a V >f H ) [C T li 

. cti* i nit»^LT#^ns^ij6^isi. j&v. 2 LTfib ft*>b*ft*£4%^$; 

S ic n L T MMX* S 3 i: fc'ff IE $ tl £ . # £ tl It . - o </> ? a V >f H -b r > > N 
^TtivS*l7^f^^^taj^)b s ii^T*>-g> o Lti'-iT, vf<b ^Tl4HcoJ|^ftM^t#£> tl£ 
. -o<7> * a v >f H ft*6*3I*ef SJ&^-lc t . * <?> o £ ^ i ic T ff Jf£ . v£«U 

ftS^jIMlC & § J: 7 tC ^ 7 > - ? * jg JR-f £ 3 t tC Jc o T x ># ^ frftU t O * g**) ftjjlg 

[ 0 0 2 4 ] 

( b ) M ffl 

ft<*tf> Jjft^j IS] * — o <?> ft ( f -v ^ ft 7k U 3 - ft ) TgSCJ: §5^)T\ 5*5* 
£ & * ft tc t> -tt 3 YK tu Eft $3 * ff «Jc ft § c t i) J T*§ , & m 3£ k: ffl £ z 

[ 0 0 2 5 ] 

' P3 5ft ♦ *a C ft ijft & if co^fSf ft ifi It x ^ay^P^7i-?^u<oi^0lcL, 
*><S Wi * < o fc*<7> ^ 7 > - 9 tc iff H8CR-(^* x. -g. ZirlCckoTfPSCi: **T« 
§5= 3 tl h ft m. It 9 n V -f K ft H <t> — ft *) . ?nMF^7t-7ntffluT 
iST'§ LfcA'oT, t£*<7>N C <^ J: 7 ic . [ft*l • P3 # • S ift*ft#k: =k o TieiEi" 
^t-v.y^fxTjnii^ffli^, [B]C "7 ^ F ^ffll^TtlLf; 1 „ M 

* x a Sfctt^uf IC 0 tl< 3 tic ioT, 2 }X7C ^ a V >f K ^ ff & Z 

t ^T'f <£> c7> T* x 3 tl * T 2 7C ^ a V -f K IC o T t T' IC H b tlT u§ 11^ Sffl t ^ 

-t=5rt)*>x Hcft^iiTv^2iX7E^n>;>f H4^ftT, P3 W ^ fi. >5r ^ co fff SU </) ft IS 
^x at ^I^tS^tl.; C cO Jc 7 & flf 8U ft *SUC o V^T [b] - <^ ff^ 

^ 3 YK7t ?o'MH ft*S^^fflv^S Z fc **T'§ 5WT\ If Sfi * m*feftT? § -So 



[ 0 0 2 6 ] 

( d) Mil L c7> H £ 

£> £ vMi ^ ffitft & ff^ a* # fc* 9 tc < c t fc* x 3 }X 7U ? n v >f K ic fcuTIi, t: -v * 

> - ? S L T . ( 7 ) , (2 0) JkV (2 6) sUc^i" J: 7 IZ . ft $g <?> ?f H ^ . ft«* 

:w;u:j:oT, ^^sici+s^f^^^*?! l . > t - * t^mw^mm-t 3 z t § 
. * tz . t u- 9 -i u x <r> If m ffi S * -t £ . 

T?ticiti%^*>s<?)k:fflffl|'S:tH[%^-t5**. ? n 7 -f h x - US tc -b r > > h r ic M 
/hft4s¥&<?Hfifc*JB£*nT*><S fc#>. ^7 >v 9 -&coMfe% £ \z is x * fU T *> § . 
[ 0 0 2 7 ] 

(e )®ift ^ D^tS 
Jc-oT. 7jnMM& tcoMM^ ttMlz^- & z t h*X § . ^7 a 4 t \z m <b tiT § 

&v>, t,fz. ft^^tm M Ift 1$ <*> 51 to flnilJg <b *u MiftfiE* 

ic jfc c M ffl * tf 7 c tK-^. 
[ 0 0 2 8 ] 

(6) ftJjft^^j&fcg-^^;* — 9 <D'\k% 

fem\z «k tit* 3 }X7£ ^ a v >f K ft 7 > - 9 **fljjftk:& is-ti^Wti <^> 4? 0 
> - 9 -g-tfiL Z t IC J: o T 13 3 co «fc 7 lc 3 )X7C ^ a V A K ft^^^^i" 
U 3 <?> i& ft *&JISl#S i: ft* K <7)M#li0 4 <?> =k 7 lc £ o 

i: 6* of 16 T *> § C t ^ ^ -5 = 

[^ 1 1 











ft cc S 




-( ) 


k = ( const ) 









[ 0 0 2 9 ] 



2 . 3iX7C*nV>fKtt*SUCj:£*i!rav£ 

( i ) mbfrnmm<7>&¥®4kft 
tc «k s x a <r> m$nm m * ± & a ® t lt> 3 ? n v ^ h ft *& ( 3 mit ? a v ^ h -t r 

> > h ) ^if Semitic L . 3 #Ctu ? a V -f K -fe r > > h lc J: o TlM^H 

^ i(l ffiP f £ o 

. z^lkftii, JJIT^ <k 7 K:IBj^Sti-5. S#J<t> 3 ^tifiH^il^'ll. iX 2 ^ ti ifift 

[»16] 

P A - f (l) = Px (+I (0) 

/ > y,(D = ^ +I (0) 

ft,(l) = Pz w (0) 

a,(l) = ct 1+ ,(0) (26) 

J3,.(1) = JS I+1 (0) 

tanv f (l) = tanv, +l (0) 

k,Q) = k m {0) 

Zflli, mffitJ&X'mB^ 9 h >l t * h ^ . ft*i:a. P 51^"? #> 5 + 

[»17] 

Px,.(l) = Px. +! (0) 

/ , 3' f (i) = J Py f+I (0) 
Pz 1 (l)=Pz w (0) 

cos[a,(l)-a f+1 (0)] = l (27) 
cos[j8 f (l)-jS f+l (0)] = l 
tanv,(l) = tan y /+1 (0) 
K { (D = K M (0) 

cos[a,-(])-a ( . +i (0)] = l 

T-fesr i & % jft {c v ^ tto t 

tan v f (l) = tanv, +1 (0) 

tan v,(l) = tanv /+1 (0) 

g'-(l) _ g' M (0) 
j3'(l)cosa ( .(l) P* w (0)cobo w (0) 
•••«', (l)jS , , +1 (0) = a'. +1 (0)£',(1) 

*S Tie^* # * if li B & -5 - £ tt5 * £ z t a» t> ^ £ . 



[818] 



Px,<X) = Px M (<B) 

Py i H) = Py i+l (0) 

Pz i (l) = Pz M (0) 

cos[a,(l)-a f+I (0)] = l (28) 
cos[j5 f (l)-j8,. +1 (0)] = l 
«,(l)jS f+1 (0)=a M (0)A(D 

[ 0 0 3 0 ] 

( 2 ) mfc®%3\-M^m 

[ 0 0 3 1 3 

(a ) 9 > - 7 h . a. ^^xt, 1 3 iX7U ^ o ( M K It, 

-e^SW^CT. (28)5*%Sffc-* <k 7 tiX<?) 3 ? n V >f H ffiifi^^ ^ > - 7 t^ft^, c 
^ i 7 lc L T x iX * £ C M h fr\z Jif^i" 5 3 iX7C * n v >f K ftijft* f££ 
. 3 </> |+ S ¥ M \z =k ti li\ ftijfc^ ^ > — 7 <7>giii li#©T*> »K c tifcJKfi? i: Pf *fco 3<t> 

[ 0 0 3 2 ] 

(b )^#>t&£3ftfcj&#**ft*ft<7>Jiif^i: <k 7 3 ^tu ?n«MH tt<**Jtl^-* 

SI (^vn*t^/>h) 3<7>j§^lcii. (28) jSfcSffc-* ck 7 tc ffiifift^ 

^ > - 9 § tf S^IWti ( a ) J: *J «?tT*> >).**») iM LiR^tfB 4 § . 3<^ff 

_hie (b ) co&ffllz o v^T . tm^v£^t¥*ffltcfeyt-t£o fS < )X<7>=k7 

* £a ^ 7 > - ? : ft *ft ^ ^ > — 7 

**n^ v > - 7 h LT^^i-til? <k v^ 0 #Ux.t2\ tt^^jl^tt**^^ $ iift^Mnlz it. 
i'JIS^ Jf^tc li, Mtcfflv^ 3^tu^ n V >f K ft*fctf>8c* ^SO lc «fc »)it^L 

±m<vBVMLW^i\-M-$:'gfelzW3i2-ez>rzdblzit. H-g±tf>I3:**'&^T?S>S. if 
5:MitMT-i>5. ^^fzdblz. H- x. h ftfcjf i!5Sj&4 £ ft sfc & # * if , cfc *) *i 

v Kft*i^ftiA'7 >-HiiLx, & 9 L^mu^mmm £ -t z £ \a?m-? 

o^)STEP tc^t+T. HSiXUfft*. IlSTEPh L T g'liffi £ gJjft^j f«I **-gCi- 
-5^7 tcffiP^ Lfc^T?. S2 STEP i: L T l«I * — &~t Z> «k 7 k:ffiM*ffv^ 13 

ste PTft^t-sc-rs =k 7 icffira-r-So z^^^<^aEti<^«t^*Ei 5 tie-t. 

[ 0 0 3 3 3 



c 3 ) m&®%atnm 

ZZX'lt. g tfe ft^HI Wfcte©. |fH?Jl«K Sc^TjftU MlC o ^Til^ft^T 3 Kit 

3D Discrete Clothoid Sp 1 i n e s <r> ^ft fit Q <r> J^ftiT? £ ffi IB W ^ ^^J m \Z TK^ ^ 2 o & 

Discrete Clothoid Sp 1 l n e s lc o v> T t£Hfl i" & . * i* . WmHM^^i ^TR^ 
fctS^iPtf^ 1 ), P 60 &T!/&ra tc IB] d ft r All o* o $r 4- 17C j&fc J¥ A L . P c Q i: ft 
■5 J: 7 ft #ft ff^ Q * fF 3 o CCTP^Mii'nifcSfctSJ:, # V =f > Q It fflC X £ 
i^Trnl, ioT^SS^Tr ( n - 1 ) + 1 flM <7) TR^% Jf o C i: IZ ft * . 

tefcv^T . ^ft t LTtSi^ ^ h ^ b *x ^£ £ i: LTft* k «k 7 ft ~* ? h ^ k 

TiB*>3* (29) fciffc L . ^ (30) <?> US # V =f > Q * 3 

D Discrete Clothoid S p 1 i n e s t H 7 „ 
[SI 9] 

(29) 

A 2 ^ = 2*, (30) 



3&7G?nvMK*l!W<?>fc#><?>#JSI!fftli* r = 3 3 D Discrete Clothoid Splines^* 
=f> Q^fF 9 . * 3 <)^^lT-ftSt§. Mlfllc^ > - 9 aO, bOlcov^TaS (31)T-$ 

[»2 0] 




(31) 



|qwqi| = |q i+ ,qi|. (q^p) 

£|A** w |r. i = {0...n-l}, 



3 <r> Jfift ?J ft ~i 9 V >i t It # -J =f > i: § lc i" T- lc gtfri t ft o T *) . z <r> t t 

x{ ( 7 ) t tc J: ») # ft ft <?o a o , b o fc* ^ $l s . :^h|t^ =f > p <^TI^T ft # =f y Q ic 

3D Discrete Clothoid Sp 1 i n e s <r> &m <T) ^ (2 9) h 3)^7U ^ n V >f K ffi*l<50 « <^ 
it(8)t*>^i±T^')«-t-5)tTie<7>^(32)^l^ , )5:o 0 
[K21] 



1_ 
3 



a0 3i +— al 3i +[ — I a2 3j =a0 



3i+! 



a0 3i +_al 3i + 



8 

3 I a ^3i — a ^3<i+l)_I 



(32) 



3 CDj^lt&frlWtfr a 1 3 j t a2 3 j^^TUil^^^gitlc ft o Tfe *) . Z ft & ffi T ^ 7 > - 
5 7 al,a2^^]^fihi-^o 1b]«Ic^^ > - 7 b 1 . b 2<?> t v^^T- § & . 

h l± x 3 iX 7U ^ a V >f Kffi^<7)ffl^<7>itct ») tfj -f & . 3 iX 7C ^ a V >f I* ft Jjfi <7> ffi * li 
. 7% { 3 3 ) T« ^ $ il S T* . 



[S22] 



jc = 



(33) 



. _ V(al 3i + 2a2 3i ) 2 +(bl 3i + 2b2 3i ) 2 cos 2 (a0 3i + al 3i + a2 3 ,.) 
n ji ir ^ v-^J 



^ ^ > - 9 <7> f] Sfj ft — - h > • 7 7*y>St ioTtft^c 3 tl \Z & o T f# h fl tz 

So if #y * in 6 & v 0 7 tc ^ -t o 

[ 0 0 3 4 ] 

& V . MS^fb^ Vf h h-\Z -t 3 3 t fr^mtt Z t X3b Z> o 
[ 0 0 3 5 ] 

(i) 2><X7t?v v a \^mm^m^rz^i$.mm^^ 

o 

[ 0 0 3 6 ] 

(a)IM3Ii$Ji»<7)^^ (08. SI) 

hf^IMHK f^II^)f^i^ (IM^, tool center point) lt¥m$)3h& 

k*'-e§4. XM^flgli. JM? (x. y. z) T-|I2*U 00 It x 

. y. z $itcWi--5 STi^ tl^o ^^)J:i=5:Ii^i§T^, I.I*^)#iittI 

Wy\k % . 3 #C7U 9 a v F ttH lc ^ff § C i: ic £> £ . 
[ 0 0 3 7 ] 

(b )MWl\Sim<vMT ltdb (08. S 2 ) 
i: L T li < ^ li s IM^^Ig-»IStaStS3hT^ft^ti4, II^^IS • fin 

-Wi®izi$\%mizMLx#!:fe2iiz>M&fr^^fr. m *. itmrnaax^ -? % m^. ^htcm. 
* n mff^ as tc *? u t a . ^ it * u mm \z mm $ nx v> & >& <?> & ^ m m -t . 

3(,* x ^<7)-o-o<^ffi^tCal®Jffi^^ iaT f]U Mil ^ ^/^"t S = ij >l ^ ^ T y ^.m h 

S^T'Sulc [S^-t 5 x . y. z <?) 3 $i^£fflv^To < ^ tl S 3 )%7tmU%<X 3b *) . X 

[ 0 0 3 8 ] 



( c ) mfrW] (08. S3) jkwu>i^r^ T>mm^ic ^ sii^fig • ^m<^t\n ( m 

8 . S 4 ) 

g • ^M^Ef m t co m $c t l x £ ^ *i c t iz & & . zniz ^ >) . BfratfcSfc/hBfrem 
^wfi*^^oTv^, jn^ s nrz&MiMf$.\z ^fisf w^^-r n ii. %.&mm*co3M& 

mMfrfrfr*). ctilci ►Jiit^ftil^^ >-f/^ftlT-§^o c^^i/m^f&M^ 

m^^-^icj:*). ^m'&^&izisrt z&w.mm^mm. m& ^^i^n-its c t & 

^<?>lSg t^^^ffS^ *i£o t LTU, 3 iX7CT?ti ( x . y. z. A. 0 
) t%Z. fzfz L . ( A x M x y . 6 ) tt^flE %#fiBHIiteT^ Lfct<^T ( A s M x y 

isfc. »fftft«Jffli*^<7>^^k: «k *) . 3 i^7t 9 n v >f H fflfflftiicio T . <* ft ^ }g 
[ 0 0 3 9 ] 

(d) ]t«»«» (0 8. S 5 ) 

Sli — $:lci#f&fltfl? ( inverse kinematics) t Pf liftT v^S c 0J £ a: 6 fi<?> a * >y h 

zt-tzt. mfflii-* 6 r>&z<7)-? ^ m^mw. mcomw. x>c<r>mw. ^w^mwv^i^ 

S0iLfc^TlM^^fig-f»^^. 3 ti*»KB*8lfll» i: Pf litis. 3^«l«»tt. 

^ji-^T^SJf^t^S**. •f^it^-e^ftffiRIJg^^te^ ^Tt-^A^J'U^ 

f 4^)T\ ft * n ,K >y N#k:ov^Ti@SUlcW%ffligL"C4J<. 
[ 0 0 4 0 ] 

(e )ttrffi£&k: «fc S g-tt^E- ?^te<7>fflf (08. S 6 ) 

mftW\$nrz&xm&\z~i%mmffiM-&&db. z n*&m^- 9 emm-r 9 * ~ ^- 9 
its $ n me &f m r t \z ma £ ft . a © ^ m s vmj b m <r> * # * m tz -t u -? ^tf $ ti 

±1Q<7)^T<^I+S^ . iCfftftlJP^g^^Tff 7 3 i: oT 0 . ifeSvMi. ( a ) & 

v ( b ) % su<t> =1 > ^ - ^ ( if nm) \z j: *j i+s^ l t § . * tt,^ ^ => > - 

^ * if^^fftiOP^glcM 0 iA^. ( c ) - ( e ) ^tfff^iCfiftlJP^gl^T'ff 7 C t t 
[ 0 0 4 1 ] 

( 2 ) n c fc c n c ^s; 

[ 0 0 4 2 ] 

^*<^ii^<^ N C tlMT'ii . 7 a r 7 5 > ^tff oTNCr-^fflttS^P 777 
i: . c cr> N C ^- 57 ^£ ffl v^TlSSMIIStill^tN C^gt<J0 — o^^gtA- H ^ x 
5>I^tlTv^„ -f- tl tc L T . SjS<7)C N C §tiST*li, 7'p 77 ^> 7 3>f- 



- 9 IZN CmW.\zftm$ tlX . - # ft 2 tl 7z t <7> i: & o T £ 0 

£ ~? . BU % <50 . ^aZI^ON C^Itffll^falCOl^T, 3 )X 7U * a 7 4 K IC J: § » fl fell 

8P^^*ffilg-r S. C^Jt ^-. ? n y ^ k t-- ? tti L C li ? p V K a- 7 > - ? $ 
ffloit^tU G =i - H <r> ^ ic ? n y 4 K <r> ~7 * - v -y h £ Sit -5 . Z titt $J z. It . 

G *fc *fc *fc 

AO, Al, A2, BO, Bl. B2. H 

G***ttG3-H^)|ft*t. AO — Hti 3 /Xtu ? a V 4 F -fe r > > h <r> 7 
-o<?>'*<7 > - 7 t^t. Z^3-K*Htft5ilc, ISllP()^fiiaic*Tv^, NC 

c^^fp^ riw»J tui. ik»*n cnuffl-z?f im&iz^- vco^mit-zm <• 

@ ft jb*<b ?#>S ft*. * #>IC N C IgT'fl . *> § ft <r> 'MM * <fc^ ^ -5 . Cn-KTJ? 

m t & * c 

[ 0 0 4 3 ] 

(b ) C N C ^ 

7' a r ^ v <7> * o 3 > - - ? fcNCt§Hfc<7>--frffc£ttfcCNCi§g<7>fl§£- 

? a V 4 Y \Z m~t £ If ^<^g^<^ — H T?tf tl £ 
SSti^'ivi. £ tz . t' - ? <r> m $z M <r> * f - K «t W i* § ti o o § . 
— I£ ic . c^7*n vicii, * fi f ti </> ^ [c iS L ? a v 4 K <r> >i=j > - 7 % v£ S 

* 3® * fl £ . 3 tl * r il » J ff IC tt s fjiif, U < O fc* <7> HlfC & 

) *b # * tl § C t > o 

[ 0 0 4 4 ] 

c 3 ) 3 /^tc ? o v ^ h* ffim*fflv^»faftijap^^<7)j|f m 

[ 0 0 4 5 ] 

Jlll^ifti'^ > - 9 IC J: >)il$nTv^X^7 > ft * if <7) ftfe<50 ft *| T" . ^Sft 
3 tl m -f £ ic . 0 9 tc ^ $ tl -5 «fc 7 tc . 7x 7° 7 -f > ft H R ( t ) T- ^ $ tl § |fi» _h 

li?S4v\ R 0 +AS = R(t 0 +At)<7)jt^^v^TAt^?t<a6^ti-tia\ S^^^ff 
tilts c fc *v^7>t?, -Si^raraFs^lc zc^ffS^^ »j 5fl:tttili«: <b z t 

[ 0 0 4 6 ] 

(b ) 3 YK7Z ? n V >f H ftllTli. ftijft^lcjhf-rs tt*^^fk<^ft^**x fifWWtc-^T 
i>5cti)^fif^ti, 3 titcWfCi-^^fftiiJP'ttffili. Mtft^IfflJ^m^^'b. t/^^lcM 
m<r>'J?*\.*MWfemt z t frWWZ tis. >f ^t?»±. ftMft 

[ 0 0 4 7 ] 

(c ) 3 )X7t ? n V 4 H ftHli. ^cOJNf^>5rJt^i: U, mm. P3 # . ISi£tt*6«:^*# 

^T♦fc ►) . mm<r> z t * < . #«^ftnicWi-^m«ftijP'i*i3^^mic 

[ 0 0 4 8 ] 



(d) 3 Aft ? a v 4 Y ft & li ffi & tt <z> t *) ?j\z «k ^ SI^gjtfi>5. x, y, z 

m t- ft & *>*fi $ n « & * <?> n c m s t- a . #j u "7 - v n #> \z m i-t x nn x -t & t § ic 

n - ? <t> fx *) it ft -n tc J: o T tt . f4 <7> ffl % ftn X L ^ f ^ o *) . fin X L tc < ^ o Tz *) ~t 
ZZhfr&h, 3 #C7C ? n V >f K ffiijftTMix ft *ft lc J: o T -4 £ h fl £ <r> X . ndbcn 

m^mx-f ^maX^j . f4<^^ffiXlcik»^fF!j£iJ-*ui\ TKXffl^r^jnXi- 3 <r> t IsJtiBcftn 
IT'§ -So 

[ 0 0 4 9 ] 

*%bh<t> 3 /Xtu ?p 1 MF ft^fUc intt, X^Ma^^tfX^lc^W t & £SWft*§<7> 
[ 0 0 5 0 ] 

[01] x. y&lg±<^2iX7C*nvMh-ftjjfcfc^i-|g 0 

[02] 2/X7C^n7O-ffiit^t0o 

[0 3] 3 #C7G * n vM K ft*ft<?> a . ^^it^tH. 

[0 4] ttilttfcft$i:<7)i1l$^tr7 7„ 

[0 5] i^^S^^tlgio 

[0 6] 3 iX7C* n vM F*tfflft*&*>0J (ft«Ucfifi.$:iMUi. J^ffi ft £ ft3fc#£* W 
[0 7 ] 3 YKjz ?nv^F fflWft*l^46^^'b^ft*l^ t ft3g<7>W&*^L 7 

[0 8] wai.mm^'&^^-txnm. 

[0 9] X ~f *7 >f > ft*ft*^-tlt«10. 



[mm%] mm 
im 1 ] 




x 

[0 2 ] 

$ n v << K 




z 




0 0.5 



[0 5 ] 



STEPl 



3 ^ D V 

f KMT-IS 



STEP2 



STEP3 

mm 



[0 6 ] 



[m 7 ] 








v s ; 

1 l 



- curve 1 
vo3 



[0 8 ] 



xftiUiWflfait - (si ) 



ZIZ7 



mm 



(S3) 







i 


Y 




mm 


- (S5) 



(S4) 



I 



(S6) 



P = P(s) , E = E(s) 
s = s (t) 
t=n -At 

P = P(t) , E = E ( t ) 

8 i =8 i (Pj,Ej ) 
0 i =0 i (t) 



[m 9 ] 




mm 

[38JREI] 133 



ajJSBAJgJB 



390029805 

20021112 



M^UffaJW EffiSJxffl 3 T@ 1 If 6? 
THKi^tt 



